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(57) Abstract 

The invenuoo relates to a method for detecting and locating obstacles in a vehicle environment. To this effect, it comprises the 
• steps of emitting sig nals in the direction of said environment from a plurality of radars (2) on the vehicle, deducing from the echo signals 
! received the probability of occupancy, by an obstacle, of a set of elementary cells (9) of said environment, and combining the probabilities 
j relative to each of said cells. 



(57) Abrege* 

L'invention concerne un precede de detection er de JocaJisation d'obstacles dans renvironnernent d'un vehicule. A ccc efret. U \ 
comprend les e tapes consistent a ernettre des signaux en direction dudit environnement a parrir d'une pluraiite de radars (2) disposes sur 
i le vehicule, a deduire des signaux recus en echo les probabilites d' occupation par un obstacle d'un ensemble de cellules elementaires (9) ; 
| dudit environnement, et a fusionner les probabilites relatives a chacune desdites cellules. 
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Procede et dispositif pour la detection et la localisation 
d'obstacles dans Tenvironnement d'un vehicule 

La presente invention concerne un procede et un dispositif pour la detection et 
la localisation d'obstacles situes dans I'environnement d'un vehicule arrete ou 
en mouvement. >■ 

Une fonction importante de la robotique mobile concerne la detection des 
objets ou obstacles situes au devant ou sur le cote du vehicule porteur, dans la 
mesure ou ceux-ci peuvent entraver son rnouvement -et doivent etre 
contpurnes, ou necessitent son arret complet par souci de securite ou, au 
contraire, sont suffisamrnent distants ou dans une direction telle que le 
vehicule peut continuer son chemin sans ecart. 

Un aspect secondare de cette detection consiste a exploiter une connaissance 
a priori du positionnement (absolu) de I'objet detecte par rapport a une carte ou 
un site plus vaste, pour qu'en detectant cet objet et en mesurant ses 
coordonnees (site et distance) on puisse en retirer une information sur la 
position absolue du vehicule lui-meme. , 

) 

Un moyen commode pour detecter des objets situes dans la peripherie d'un 
vehicule et permettant d'en mesurer les coordonnees consiste a utiliser des 
capteurs a ultra-sons. s 

Selon cette technologie bien eprouvee, une onde acoustique est emise 
periodiquement et, se trouvant reflechie par les objets constituant des 
obstacles a sa propagation, revient vers le capteur apres un temps de retard, 
iequel depend directement de la distance de I'objet ainsi detecte. 

Pour assurer la detection peripherique d'un vehicule, il convient de disposer un 
nombre suffisant de tels capteurs sur son pourtour en fonction de Tangle 
d'ouverture du capteur elementaire. Ce nombre est d'autant plus eleve que les 
capteurs auront un lobe de detection etroit. . 

L'utilisation de ces capteurs fournit une information de distance par rapport a 
un obstacle, mais rinformation d'orientation angulaire est d'autant moins bonne 
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que les capteurs sont a lobe large. En effet, dans la mesure ou un capteur voit 
un obstacle donne non pas en un point de 1'espace mais de maniere ambigue 
en tous points situes a egale distance, si Ton associe plusieurs capteurs pour 
assurer la couverture du perimetre du vehicule, redetermination de la position 
angulaire des obstacles detectes peut etre excessivement grande. 

A contrario, une detection plus fine exige un nombre superieur de capteurs 
elementaires, a lobes plus etroits, ce qui accroTt le cout global de la detection." 

Un autre inconvenient de I'utilisation de capteurs a ultra-sons est leur tres 
grande sensibilite aux perturbations acoustiques exterieures, aux anomalies de 
reflexion sur certains obstacles, ainsi que la sensibilite au vent des ondes 
sonores, I'echo pouvant meme etre souffle et ne jamais revenir a sa source. 

La presente invention vise a pallier ces inconvenients. 

A cet effet, rinvention a tout d'abord pour objet un precede de detection et de 
localisation des obstacles situes dans I'environnement d'un vehicule, 
caracterise par le fait qu'il comprend les etapes consistant a emettre des 
signaux en direction dudit environnement a partir d'une pluralite de radars 
disposes sur le vehicule, a deduire des signaux re?us en echo les probabilites 
d'occupation par un obstacle d'un ensemble de cellules elementaires dudit 
environnement, et a fusionner les probabilites relatives a chacune desdites 
cellules. 

Des algorithmes de fusion deformations sont deja connus dans la technique. 
Toutefois le fait de fusionner des probabilites d'occupation de cellules 
elementaires, ces probabilites etant elles-memes obtenues a partir de signaux 
radar, peut donner, avec la technique selon rinvention, des resultats tout a fait 
surprenants par leur precision, permettant meme la cartographie des obstacles 
detectes et rendant done possible leur evitement ainsi que la localisation du 
vehicule lui-meme, du fait de la grande qualite de la modelisation de 
I'environnement ainsi effectuee. 

Par ailleurs, contrairement aux capteurs a ultra-sons, les radars peuvent etre 
utilises en exterieur et par tout temps. 
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Enfin on a pu constater que Tinvention permet meme d'utiliser des radars de 
performance individuelle relativement mediocre sans alterer les resultats de la 
moderation globale. 

Dans un mode de realisation de I'invention, la fusion est effectuee sur les 
valeurs des probabilites fournies par une pluralite de radars, et notamment 
deux radars. 

Dans ce cas, la fusion est effectuee de maniere spatiale de maniere a associer 
des donnees retournees simultanement par un sous-ensemble de radars ayant 
detecte un meme obstacle sous des angles differents. 

Dans un autre mode de realisation, la fusion est effectuee sur la valeur de la 
probability fournie par un radar et la valeur de la probability anterieurement 
connue pour la meme cellule. 

La fusion est dans ce cas effectuee de maniere temporelle, le meme obstacle 
etant vu successivement par un meme capteur qui aura avance en meme 
temps que le vehicule. Dans ce cas, I'operation de fusion est appliquee a la 
valeur deja affectee a la cellule. 

On peut deduire des signaux regus en echo une information de distance et une 
information angulaire sur les obstacles et determiner lesdites probabilites 
d'occupation a partir de ces informations. 

De preference on prevoit une etape de seuillage des resultats de la fusion de 
maniere a obtenir une carte depouillee des artefacts divers pouvant provenir 
de reflexion speculates ou multiples, des ondes radars emises. 

Selon un mode de realisation particuliere de I'invention, le signal emis par les 
radars est module en frequence, le signal regu en echo est melange a une 
fraction du signal emis pour, apres elimination de la frequence porteuse, former 
un signal de battement, et les impulsions de battement sont comptees pendant 
un intervalle predetermine pour fournir la distance d'un obstacle. 
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En variante, cette distance peut etre fournie par transformation de Fourrier. 

Avantageusernent, remission de chaque radar dure un temps limite et la 
logique de repetition peut meme etre codee en vue de Identification de la 
5 source. 

[.'invention a egalement pour objet un dispositif pour ia modelisation de 
Penvironnement d'un vehicule, caracterisee par le fait qu'il comprend une 
pluralite de radars montes sur le vehicule et une unite de traitement agencee 
io pour fusionner ies donnees fournies par les radars. 

Grace a Toperation de fusion, on peut sans inconvenient choisir des radars a 
lobe large, done de performance moyenne et de cout peu eleve. 

15 On observera que les radars de ce type, notamment les radars Doppler 
courants, sont generalement utilises en mesure de vitesse alors qu'ici, e'est la 
distance qui est mesuree a titre principal, la mesure de vitesse n'etant 
eventuellement utilisee qu'a titre accessoire. De surcroit, alors que les radars 
utilises en vue de mesures de distances sont generalement des radars 

20 fonctionnant en impulsions, on utilise ici de preference des radars a emission 
continue et fonctionnant en modulation de frequence. 

On decrira maintenant a titre d'exemple non jimitatif un mode de realisation 
particulier de I'invention, en reference aux dessins schematiques annexes dans 
25 lesquels : 

- la figure 1 est une vue schematique de dessus d'un vehicule muni des 
moyens de Tinvention, 

30 - la figure 2 est un diagramme fonctionnel de ces moyens, 

- la figure 3 illustre les signaux emis par les radars, 

- la figure 4 represente la modelisation de Tenvironnement du vehicule, 

35 
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- la figure 5 illustre la fonction de repartition des probabilites d'occupation d'une 
cellule par un obstacle en fonction de la distance au foyer d'une antenne et 

- la figure 6 illustre la fonction de repartition des probabilites d'occupation de 
5 cette cellule en fonction de I'ecart angulaire entre sa direction et I'axe de 

I'antenne. ? 

La figure 1 represente un vehicule automatique muni d'une plate-forme 1 sur 
laquelle sont montes une pluralite de radars 2, par exemple une vingtaine. Les 
io radars 2 sont ici des radars a lobe large, c'est-a-dire d'angfe d'ouverture 29 
typiquement compris entre 15° et et 120°. On rappelie qu'un angle 20 important 
est recherche pour obtenir une bonne couverture peripherique autour du 
vehicule avec un nombre de capteurs aussi reduit que possible. 

15 Les radars 2 sont ici des radars FMCW a modulation de frequence et a 
emission continue ou par fenetre temporelle. 

Les radars 2 sont places a la peripherie du vehicule de maniere a obtenir une 
vision aussi complete que desiree de son environnement. La finesse de la 
20 couverture de detection et de la moderation en general, depend directement 
du nombre de radars utilises dont les lobes individuels peuvent se rejoindre 
arbitrairement comme cela est repesente vers I'avant (fleche 3) et le cote du 
vehicule. 

25 On voit sur la figure 2 trois des antennes radars 2a, 2b et 2c. Chacune de ces 
antennes est reliee par I'intermediaire d'un circuit d'inteface 4a, 4b, 4c 
respectivement, a une unite 5 susceptible d'elaborer les signaux de 
declenchement Sa, Sb et Sc respectivement des radars. En variante, les 
signaux de declenchement peuvent etre communs a tous les radars. 

30 > 

Les signaux Sa, Sb, Sc sont modules en frequence comme represente a la 
figure 3. Une frequence porteuse Fp est modulee par une onde en dent de scie 
de frequence Af. Cette generation de frequence peut etre assuree au niveau de 
Tunite 5 par une diode oscillatrice GUNN. 

35 
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Optionnellement, pour chaque signal Sa, Sb, Sc, remission modulee dure un 
temps limite D. On facilite ainsi la differenciation des signaux re^us ainsi que 
['extraction des informations recherchees. Par ailieurs, en codant la logique de 
repetition des emissions, c'est-a-dire la duree T sur la figure 3, par exemple 
5 selon un modele pseudo-aieatoire, il est possible de personnaliser chacune 
des emissions. On peut ainsi en particulier faire evoluer plusieurs vehicuies 
dans le meme environnement. 

Le signal re<?u en retour par chaque antenne 2a, 2b, 2c est traite dans une 
io unite de traitement analogique 6a, 6b, 6c respectivement 

Le signal regu est dephase par rapport au signal emis. Par melange dans 
Punite 6 correspondante avec une fraction du signal emis, apres elimination de 
la frequence porteuse, un signal de battement a une frequence type de I'ordre 
15 de 1 kHz est obtenu. 

Le signal est tout d'abord filtre pour eliminer les hautes frequences, 
correspondant aux obstacles les plus eloignes. On ne retient ainsi que le signal 
retrodiffuse par le premier obstacle rencontre, qui est ensuite traite par 
20 transformee de Fourrier. 

Par ailieurs, la comparaison de la frequence de Tonde porteuse retrodiffusee et 
de celle de Tonde porteuse du signal emis donne la frequence Doppler qui 
est proportionnelle a la Vitesse de rapprochement ou d'eloignement du vehicule 
25 de ('obstacle detecte, selon la relation : 

v = 1/2 XF d 

ouX = c/F (vitesse de propagation/frequence d'emission) 

30 

LMnformation de vitesse n'est pas necessaire a la mise en oeuvre de 
('invention. Sa disponibilite constitue neanmoins un avantage dans les 
applications. 

35 Les informations de distance et vitesse numerisees sont fournies par les unites 
de traitement analogiques 6a, 6b, 6c au processeur numerique 7. 
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Le processeur 7 est constitue pour Tessentiel d'une unite de calcul susceptible 
d'acceder a une memoire 8. 

A chaque element de la memoire 8 est associee une cellule elementaire 9 de 
I'environnement du vehicule. Le contenu de chacun de ses elements de 
memoire represente la probability pour qu'une cellule particuliere, reperee par 
son site <i> et sa distance d par rapport au vehicule, renferme un obstacle. ■ 

La figure 4 represente 2 radars 11 et 12 ayant chacun detecte un obstacle, le 
premier a la distance d-j et le second a la distance d2- Par convention, on 
decide que la probabilite d'occupation d'une cellule par un obstacle est 
comprise entre -1 (la cellule est certainement non occupee) et +1 (la cellule est 
certainement occupee), la probabilite p - 0 correspondant a I'incertitude. 

Connaissant la position du foyer de chaque antenne ainsi que son axe de 
visee, on affecte a chaque cellule une probabilite ^occupation fonction de la 
distance a laquelle un obstacle a ete detecte, de la distance de cette cellule au 
foyer de Pantenne et de Tecart angulaire entre Taxe de visee de I'antenne et la 
direction de la cellule. A titre d'exemple, la figure 5 represente la fonction de 
repartition des probabilites d'occupation d'une cellule en fonction de sa 
distance au foyer de I'antenne du radar 11, et la figure 6 la fonction de 
repartition des probabilites en fonction de I'ecart angulaire a entre I'axe de 
cette antenne et la direction consideree. La probabilite maximale est bien 
entendu rencontree pour la distance d-j et dans la direction de vise de 
I'antenne. 

Les differentes zones de probabilites sont portees sur les figures 4 a 6. La 
zone B de probabilite positive sur la figure 5 correspond a deux bandes 
annulaires de part et d'autre du cercle de rayon d-j. On verifie par ailleurs sur 
la figure 5 que seul le premier obstacle rencontre est pris en compte puisqu'au- 
dela d l une certaine distance (zone D) fonction de d-j aucune information n'est 
apportee par la mesure. De meme sur la figure 6, aucune information n'est 
apportee par la mesure en dehors du lobe d'emission (zone A). 
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Les niveaux possibles de quantification entre les valeurs -1 et +1 dependent 
des performances du materiel de calcul utilise, la performance globale de la 
representation de I'environnement etant d'autant meilleure que ces niveaux 
sont plus nornbreux. 

Lorsque Ton a de cette maniere affecte a une cellule donnee, par la mesure 
effectuee a Paide du radar 11, une probability p1 d'occupation de cette cellule 
par un obstacle et ? par la mesure effectuee a I'aide du radar 12, une probability 
p2, on met en oeuvre I'algorithme de fusion suivant : 

• si p1 > 0 et p2 > 0. 

F(p1, p2) = P 1 + P 2-p1.p2 

- si p1 < 0 et p2 > 0 

F(p1,p2) = p1 +p2 + p1.p2 

- si p1 < 0 et p2 < 0 

p1 + p2 

F(p1,p2)= 

1 -Min (p1,p2) 

Cet algorithme peut etre mis en oeuvre de la fagon decrite ci-dessus, c'est-a- 
dire spacialement, en fusionnant les informations de probability provenant de 
deux radars, ou encore de maniere ternporelle, en utilisant reformation de 
probability provenant d'un seul radar et en la fusionnant avec la probability 
deja presente pour la cellule consideree dans la memoire 8. 

Les probabilites d'occupation de Tespace s'expriment continument entre -1 
(cellule certainement vide) et +1 (cellule certainement occupee). On realise 
ensuite un seuiliage des resultats de la fusion brute de maniere a obtenir une 
carte de I'environnement du vehicule sur laquelle sont portes les obstacles. 
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On peut d'ailleurs ameliorer la representation de cette carte en lui faisant subir 
une operation morphologique de type M fermeture M (dilatation - erosion), connue 
dans le domaine du traitement d'image. 

La carte ainsi obtenue fournit ainsi une information precise sur Tenvironnement 
du vehicule et permet : 

- son evolution avec evitement eventuel d'obstacles ; 

- sa relocaiisation par comparaison entre les emplacements mesures des 
obstacles et une connaissance a priori de ces obstacles. 

On peut par ailleurs envisager d'autres systemes emetteurs-recepteurs de 
signaux que le radar, par exemple de telemetres laser ou infrarouge ou des 
sonars. 
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